#include <Servo.h>

Servo LeftServo;
Servo RightServo;

int LeftServoPin = 22;
int RightServoPin = 24;

int ServoPos1 = 0;
int ServoPos2 = 0;

int CurrentState = 0;

//States
const int PREFLIGHT = 1;
const int FLIGHTTEST = 2;
const int FLIGHT = 3;

void setup()
{
  LeftServo.attach(LeftServoPin);
  RightServo.attach(RightServoPin);
  
  CurrentState = PREFLIGHT;
}

void loop()
{
  switch(CurrentState)
  {
    case PREFLIGHT:
    {
      
      break;
    }
    
    case FLIGHTTEST:
    {
      
      break;
    }
    
    case FLIGHT:
    {
      
      break;
    }
  }
}
  
